Bulletin of Electrical Engineering and Informatics 
Vol. 12, No. 4, August 2023, pp. 2095~2104 
ISSN: 2302-9285, DOI: 10.1159 1/eei.v12i4.3869 O 2095 


Distributed formation control for groups of mobile robots using 
consensus algorithm 


Ryandika Afdila, Fahmi, Arman Sani 


Department of Electrical Engineering, Faculty of Engineering, Universitas Sumatera Utara, Medan, Indonesia 


Article Info ABSTRACT 

Article history: The increasing implementation of autonomous robots in industries and daily 
life demands the development of a robust control algorithm that enables 

Received Mar 30, 2022 robots to perform their tasks successfully. Critical tasks such as rescue 

Revised Nov 27, 2022 missions and area exploration require robots to work cooperatively in a 

Accepted Dec 16, 2022 formation to accomplish the tasks quickly. Moreover, the existence of 


obstacles in the environment requires all the robots' to rapidly process 


environmental changes to maintain the formation pattern. Thus, this paper 
Keywords: introduces a distributed robot formation control system using the consensus 
algorithm that enables a group of robots to establish and maintain formations 
using only the local information of the robots. Furthermore, an obstacle 
avoidance algorithm based on the distance and angle between robots and 


Consensus algorithm 
Distributed control 


Formation control obstacles is introduced to ensure safe navigation for the group of robots. The 
Mobile robots algorithm's effectiveness is demonstrated by a multi-robot system with 
Obstacle avoidance randomly generated starting positions and velocities, where it is shown that 


the robots can agree on the control variables and establish the required 
formation while also avoiding obstacles in the environment. 


This is an open access article under the CC BY-SA license. 


Corresponding Author: 


Ryandika Afdila 

Department of Electrical Engineering, Faculty of Engineering, Universitas Sumatera Utara 
Jl. Politeknik, Padang Bulan, Medan Baru, Medan, Indonesia 

Email: ryandika@usu.ac.id 


1. INTRODUCTION 

Formation control systems for groups of robots are generating considerable research attention due to 
their potential for usage in various disciplines, including land exploration, surveillance, high-precision 
agriculture, and rescue operations [1]—[3]. The term formation control system refers to the capability of a 
collection of robots to construct a geometric formation and then travel to a destination while preserving the 
formation. The purpose of research on the formation control algorithm is to reduce the time and risk for 
humans in doing time-consuming and hazardous tasks. For example, in area exploration work, a robot's 
sensors may be focused on a single region while other robots scan other regions by traveling in a formation. 
As a result, the scan's coverage area is larger and more precise. Additionally, by doing tasks in formation, the 
robot's time necessary to execute tasks such as search and rescue operations can be reduced [4]. 

To establish and maintain a specific configuration, each robot in the group must collaborate. A 
suitable control method for multi-robot formation is indicated to contain the following characteristics [5]: 
i) high scalability in order to accommodate an increasing number of robots, ii) robust, such that even if one of 
the robots fails, the formation remains intact, and iii) have a flexible form that allows it to go through 
passageways and around obstacles in the surroundings. Control strategies for multi-robot formation control 
can be classified into centralized and distributed control. In a centralized method, a single robot serves as a 
leader and directs the group's movement. Thus, a centralized computing unit with high computational 
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capabilities is needed to process all the information. On the other hand, the distributed control method only 
requires the robots’ local information, such as velocity, direction, and distance to obstacles, minimizing the 
resources needed to process the information and negating the need for a central computing station [4], [6]. 

Several studies have been done on distributed formation control algorithms. A behavior-based 
formation control system is developed based on the robot's relative location to nearby robots and obstacles 
[7]. The distance between the robot and the obstacle is used, and the concept of escape angle is introduced to 
decide when the robot's headings should be adjusted to avoid the obstacle. Another research uses artificial 
potential field (APF) to control robots' formation [8], [9]. Research by Rezaee and Abdollahi [8] presents a 
control technique for mobile robots based on the virtual structure where a virtual mobile robot is placed in the 
middle of the formation and acts as the group leader. Drawing inspiration from electric charges, the virtual 
mobile robot pulls or pushes other robots toward the desired formation configuration. An obstacle avoidance 
based on the rotating potential field is also introduced, allowing the mobile robots to steer away from 
obstacles smoothly without getting stuck in local minima. A control system for vehicle platooning and 
merging is presented using the APF approach [9]. APF is used to pull or push a vehicle from another vehicle. 
The automobile uses the control system to follow other cars, shorten the space between them, avoid 
obstacles, and platoon. The simulation findings indicate a consensus on the control variables is achieved after 
18 seconds. 

According to Savkin et al. [10] implements the concept of consensus variables to update a robot's 
position, linear velocity, and angular velocity based on the adjacent robots' local information. The consensus 
algorithm finds similar speeds and heading for the robots to establish a particular formation pattern. The 
robot's maximum linear and angular speeds are restricted to simulate real-world situations. As a result, the 
robots could form multiple formation patterns in the environment without obstacles. Another work in [11] 
considers a system with different types of agents. The consensus algorithm is used with the internal model 
principle to track reference variables responsible for updating control variables and making the formation 
scalable. Finally, Hasan and Raafat [12] utilizes the particle swarm optimization (PSO) method to speed up 
the convergence time of the consensus algorithm for feedback coefficient in multi-agent systems. From the 
experiments, it is shown that the convergence of the feedback coefficient can be achieved in 115—120 
iterations by using PSO compared to 500 iterations without using PSO. 

While both distributed and centralized control approaches are feasible, distributed control is 
preferred due to its cheap operational costs, robustness, scalability, and reduced system requirements [4]. As 
a result, distributed control is utilized in this study to control the robots' formation. Additionally, because 
several objects in the area might obstruct the robots' movement, the robots require an obstacle avoidance 
strategy to travel safely to the target in a congested environment. The utilization of obstacle avoidance 
algorithm in formation control protects the robots from colliding with each other when building the formation 
and maintain the formation when moving to the target, even if obstacles are present. Sensing modules are 
used by the robots to locate the presence of the obstacle. The obstacle avoidance algorithm will then advise 
the robot on the best course of action to avoid the obstacle [13]. This algorithm is divided into reactive 
control and motion planning. In motion planning, the obstacles and targets positions are known initially; the 
controller then computes the optimal path towards the target while avoiding an obstacle in their surroundings 
and orders the robots to move to the target [14]—[16]. On the other hand, using reactive control algorithms, 
the position of the obstacles is not known in advance; the robot detects them through a sensor as it moves, 
and the controller promptly directs the robot to avoid them [17]-[19]. 

This paper applies the algorithm in [10] and adds an obstacle avoidance algorithm based on the 
distance and angle of the robots toward the obstacles. We assume that the robots have a restricted 
communication range and that the position and structure of the obstacles are unknown at first and become 
known when the robot senses them. Moreover, no leader is assigned to the group, and the robots are modeled 
using the standard mobile robot kinematics equation with certain linear and angular velocities constraints. 
This work is aimed to develop an algorithm for the formation and navigation of groups of mobile robots used 
in search and rescue missions. 


2. RESEARCH METHOD 
2.1. Robot kinematics 

Before we can control robots to create the desired pattern, we must first understand their kinematics. 
In other words, we require knowledge about the robot's movement. A robot may be categorized into two 
types based on its movement: holonomic and non-holonomic. A holonomic robot can move freely in all 
directions, such as a robot equipped with a castor wheel. By contrast, a non-holonomic robot, such as mobile 
robots move using velocity and angular velocity. This implies that the robot will need to speed and change its 
direction to approach the target. The mobile robot employed in [10] has the motion as (1)-(3): 
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x= vi( 8) cos( 66) (1) 
VAD=VAO sin GD) (2) 
ORMO) (3) 


x,(t) and y,(t) indicate the robot’s coordinate in x-axes and y-axes, respectively, and 6,(t) 
represents the robot's orientation, which has a value of [-z, n]. In (1)-(3) demonstrate that the robot's velocity 
determines its location, but the angular velocity determines how the robot spins. The velocity and angular 
velocity in these equations are not constrained and may have a significantly large value. However, in real 
world, mobile robots do not have a high linear velocity, and a high angular velocity would result in a short 
turning radius, which is unrealistic for an actual mobile robot [6]. Thus, for the robot to accurately portray 
how a vehicle would operate, some limitations must be included [10]: 


wW” < w(t) < wo™™, Vt 20 (4) 
—V™< v(t) < V“, Yt =0 (5) 


Following that, the robots’ position and velocities are then converted into two-dimensional vectors, 
zi(t) and V;(t) [10]. 


HO), ye) = (aa 


yi(t) v;(t)sin(6,(t)) (6) 


z(t) = ( 


2.2. Robots communication 

The communication channel allows the robot to communicate information about its environment 
with other robots. However, the range of communication is limited due to energy limitations for transmitting 
and receiving data. As a result, in multi-robot systems, local information of a robot is passed to its neighbor 
within the communication range before it can be sent to other robots outside the communication range. The 
robot interaction within the group can be depicted using graph theory where the robots’ locations are 
represented by the network vertices and the information flow between the robots are indicated by the graph’s 
edges [20]. The graph theory technique has been utilized to preserve the formation in groups of robots 
exchanging local information and ensure the scalability and stability of the formation [21]-[23]. 

This work assumes that a wireless communication network with a coverage area of r, is used by the 
robots for exchanging local information. The robot can only communicate with other robots inside its coverage 
area. However, the robot may still get information about robots not covered by the coverage area from another 
robot within the communication range. The communication issue that arises when various robot systems 
communicate is illustrated in Figure 1. The undirected graph G(k) can describe communication between robots, 
with the robots acting as nodes and the communication link between two robots acting as an edge. 


R Communication range 


i om 


Robot B is within 
the Communication 
range of Robot A an 
receives its’ local 
information. 


Figure 1. Communication in multi-robot system, adapted from [6] 
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2.3. Formation building algorithm 

Formation building for the groups of robots is done using the consensus algorithm which allows 
robots in multi-robot systems to agree on a specific value of variables required to drive the robots, such as 
position, velocity, and orientation. The consensus algorithm is utilized in a variety of formation control 
approaches, from the centralized approach [24], [25] where the leader’s control variables become the 
reference for the follower robots, to the distributed approach [26], [27] where local information of the robots 
are exchanged to update the groups' control variables. Consensus variables are employed to get the 
formation's common orientation 6;(k), initial coordinates %;(k) and ¥;,(k), and linear speeds 0;(k). At time 
k=0, the robots have varying orientations, velocities, and initial positions. However, as time continues, the 
consensus variables are updated according to the exchanging information and the robots finally agree on a 
particular velocity and heading. The following formula is used to update the consensus variables [10]: 


i(k) + È jevi 6; (k) 


1+ |N(k)| 
i(k +1) = EAD Bo O eH 
(k) (k)+ > (k) (k) (7) 
i(k) + Fi(kK) + View jC) + F 
j+ = Y aan, ON E 
0(k +1) = PO + Zjem Fi(K) 


1+ |N(K)| 


The equations above are explained in Figures 2(a) and 2(b), where it is assumed that at time k, robot 
R1 can obtain information from robots R2 and R3 but not from R4. Thus, when robot R1 updates its 
orientation (01) headings' information of R2 and R3 will be utilized, as shown in Figure 2(a). Hence, the 
mean of 61, 62, and 63 at time k gives the value of 0ı(k+1) [6]. Similarly, Figure 2(b) shows the scenario 
where robot R1 updates its position in accordance with the position of R2 and R3 because R1 was only able 
to receive information from R2 and R3. Formation pattern can be achieved by introducing a configuration (C) 
parameter that specifies the coordinates of the desired configuration in the x- and y-axes; C={X1, X2, X3, ..., 
Xn, Yı, Y2, Y3, ..., Yn}. For instance, a rectangular formation with four robots will have the configuration 
variable of C={0,0,2,2,0,1,0,1}. 

Each robot (i) is set to travel toward a fictional target (7;) rather than the actual target. The fictional 


; ie : ; ia 2uM i 
target is positioned in front of the robot at a distance specified by c = ue The robot is set to move toward 


max* 
the fictional target because when the distance between the robot and the actual target decreases, the w;(t) 
will increase and violate the restriction in (4). Figure 3 illustrates the control algorithm's architecture. 
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Figure 2. Consensus variables update strategy (a) headings update and (b) positions update [6] 
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X-Axis 


Figure 3. Parameters for the system [6] 


The location of the fictional target is denoted by the two-dimensional vector g;(t) and shown by [10]: 


xy. (ute if x(t) < hit) 
Gi) = Loe if x,(t) > h,(t) 


g} (t) = iE + FCC) + Y; (8) 
_ (KO 
g(t) = (A) 


To ensure the mobile robots always navigate toward the target's direction, we created the vector h;(t) and 
function f to compare the degree of vectors h, and hz and decide the robot’s moving direction. 


f (Ay, hz) = sign (a) 


(9) 
h(t) := (xit) + %,(t)) + Xi + t0) 
Finally, the control algorithm for the system is specified by [10]: 
ney VR PaO s WO 
V™ if x(t) > h,(t) 
(10) 


wilt) = w™*f (V(t), di(t)) 
Where f (v; (t), d;(t)) is w,(t) which indicates the angle between the robots and targets’ headings. 


2.3. Obstacle avoidance algorithm 

This work uses the technique described in [6], where a range sensor is equipped to a robot to provide 
the angles and distances between the mobile robots and the obstacles. This information is then utilized to 
compute the best course of action in avoiding obstacles in the environment. This method considers two 
scenarios; when the obstacle is perpendicular to the robot and when a curve obstacle is sensed. 

Figure 4 illustrates the first scenario. In this scenario, when an obstacle enters the range of the sensor 
(r,), the robot quickly adjusts its trajectory to move away from the obstruction, establishing a space between 
the robot and the obstacle. The robot must maintain this distance to avoid the barrier. The robot's turning 
radius (R,) must be evaluated so that the robot may maintain a minimum distance from the barrier. The 
following equation can be used to compute the robot's maximum turning radius and minimum distance [6]: 


y™ 


max — 
Rg ~~ ammin 
w 


(11) 


— max 
dmin => R; 
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Figure 4. Robot perpendicular to the obstacle [6] 


The last case is when the obstacle’s curvature is sensed by the robot, as shown in Figure 5. A reference 
point is the furthest point that the robot can detect. Since the robot is travelling parallel to the obstacle, an angle 
between the reference point and robot’s heading is formed, which is referred to as the avoidance angle (ġo). 
Because of the obstacles’ curvature, the avoiding angle (@) is larger than the avoiding angle when the obstacle 
is flat (pọ). Thus, to keep the distance, the robot needs to adjust its heading by Ad = | — pol towards the 
obstacle. The distance between the mobile robots and the obstacles is dọ = r, sin do. 


Figure 5. Detecting an arched surface [6] 


Thus, the obstacle avoidance method used in this work is given by [6]: 


vit) = Ve 
(12) 
wilt) = wo™* sign(y;(t)) 
for i=1, 2, 3, ..., n, and y(t) is: 
1 ifp< po 
pit) =40 if d= ġo (13) 
—1 if ọ> ġo 


3. RESULTS AND DISCUSSION 


In the first experiment, a system where the robots have random initial position and velocities and no 
obstacle in the environment are considered. The robots have limited range of communication (7,) and are 
able to share their local information between each other. Then, the robots must form a formation and navigate 
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towards the target. For this experiment, the desired formations are the square and hexagonal formation. The 
parameters used in this experiment are shown in Table 1. 


Table 1. Control inputs and configuration for the formation 


Parameters Value 
Vmax 3 m/s 
To 3m 
Number of Robots (n) 4 and 6 Robots 
[0.707 0.707; -0.707 0.707; -0.707 -0.707; 0.707 -0.707] 
Configuration settings (Square formation) 


[0 0; 4 0;6 2v3; 4 4v3; 0 4V3; -2 2V3] (Hexagonal formation) 


After the control systems algorithm in (7) is applied, the position and velocities of the robots 
converge after 120 iterations to the same value as shown in Figure 6 where different velocities of the robots 
converge to 1.76 m/s. This shows that the consensus algorithm is working. Next, we do the simulation to test 
the formation-building algorithm based on the parameters from Table 1. We found that 4 robots that initially 
had random starting positions and speeds could achieve consensus and form a square formation, as shown in 
Figure 7(a). Furthermore, we also tested the hexagonal formation for 6 robots, as shown in Figure 7 (b). 


Robot Velocities 


V Robot 1 
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V Robot 3 
V Robot 4 
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Figure 6. Consensus of the robots’ velocities 
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Figure 7. Formation building simulation result (a) robots forming square formation and (b) robots forming 
hexagonal formation 
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Figures 7(a) and (b) show that the robots can successfully form the desired formation and navigate 
to the target. From the 4 robots’ simulation we found that the initial coordinates of the robots were 


0.707 0.707 20.215 10.449 

—0.707 0.707 . : 18.792 10.462 . A 

-0707 —0.707 the final coordinates were 18.795 9.050 |" When the final coordinates of the robots 
0.707 —0.707 20.198 9.040 


were subtracted, we found that the final coordinates of all the robots in the group are similar 
19.508 9.742 


19.499 9.755 f . ; we si 
19502 9757 which shows that the robot were able to achieve consensus on their position. This is proven 
19.491 9.747 


by Figure 8 which shows the control input for each robot converge to zero, minimizing the error between the 
error of the designed control system. 


Consensus ofthe control inputs 


c 
Ñ 
Mc x exe x x 


SY u4 
5 Ric 
X 8.258 
a Y 0.06617 


control input, u(t) 


t (sec) 


Figure 8. Consensus of the control inputs 


Finally, in the second experiment the obstacle avoidance algorithms in (11) and (12) is applied to the 
control system. We consider a system where robots need to avoid the obstacle while moving through the 
environment. The robots avoid the obstacle by sensing the distance and the angle between them and the 
obstacle and then determined whether the sensed distance is within the specified safe distance. The safe 
distance is used to enable the robots to turn safely if there is an obstacle ahead and it is determined by putting 


. i ; y™ : : 
constraint on the robots’ turning radius G Figure 9(a) shows that the 4 robots forming a square 
min 


formation can safely avoid the obstacle in the environment while maintaining their formation, and 
Figure 9(b) shows that the groups of robots arrived at the goal while still in a square formation. 
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Figure 9. Obstacle avoidance simulation result (a) robots avoiding obstacle while maintaining formation and 
(b) robots arrived at goal in formation 
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At the start of the simulation, robots formed a square formation and navigated towards the goal, 
indicated by a red-colored star-shaped symbol in Figures 9(a) and 9(b). When an obstacle exists on the 
robot’s path, the robots steer from it while maintaining the formation, as shown in Figure 9(a). Next, the 
robots continued to move until they reached the goal while still in a square formation, as shown in 
Figure 9(b). This result proved that the proposed algorithm is suitable for controlling the formation of robots 
even when obstacles exist in the environment. 


4. CONCLUSION 

Multiple robot systems have been widely used to complete complex and time-consuming jobs when 
done by a single robot. To complete the complex work, the robots must be able to coordinate with each other 
so that they can form a formation that can shorten the time of task execution. The distributed control system 
is believed to have the best performance to control the behavior of the robot in forming and maintaining the 
formation due to its robustness, scalability, and flexibility. Therefore, in this study, a formation control 
system is designed using a consensus algorithm that allows each robot to send their local information and 
process it without having to have a leader. Based on the simulation results, it is shown that the robots can 
reach consensus and form the desired formation. In addition, the robots are also able to maintain their 
formation while avoiding obstacles and navigating to their destination. 
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